NONLINEAR OBSERVERS FOR GYRO CALIBRATION 


Julie Thienel* and Robert M. Sanner* 

Nonlinear observers for gyro calibration are presented. The first observer esti- 
mates a constant gyro bias. The second observer estimates scale factor errors. 
The third observer estimates the gyro alignment for three orthogonal gyros. The 
convergence properties of all three observers are discussed. Additionally, all three 
observers are coupled with a nonlinear control algorithm. The stability of each of 
the resulting closed loop systems is analyzed. Simulated test results are presented 
for each system. 


INTRODUCTION 


Gyroscopes, also known as Inertial Reference Units (IRU) or gyros, are part of the attitude 
control system of most three-axis stabilized spacecraft. They measure the spacecraft angular rate. 
Unfortunately, the gyro measurements are corrupted by errors in alignment, scale factor, and bias, 
as well as random noise. 1 Several algorithms for estimating the errors, as well as the noise charac- 
teristics, are available. 2-8 Most algorithms rely on linear techniques, and are not coupled directly 
with the spacecraft control. 

The published nonlinear methods tend to follow a similar Lyapunov development to determine 
stability, most are driven by a measurable attitude error. Alonso, et al. in Ref. 9 develop a nonlinear 
observer for relative attitude and rate estimation with an application to spacecraft formation flying. 
Salcudean in Ref. 10 develops a nonlinear observer for angular rate estimation. Both observers 
are driven by a computed attitude error. However, in order to estimate the rate, both observers 
require knowledge or estimation of spacecraft torques. The stability of the observer developed by 
Salcudean requires an assumption that the system eventually behaves as a linear time invariant 
system. In Ref. 11, Vik, et al. develop an angular velocity observer, in addition to a position and 
velocity observer, for use in a Global Positioning System (GPS)/Inertial Navigation System (INS). 
The angular velocity observer is actually a nonlinear observer for gyro calibration. The observer 
is designed to estimate corrections to the gyro measurements, particularly misalignment and scale 
factor corrections, along with gyro biases. The misalignment and scale factor errors are assumed 
to be small. All the error terms are modelled as exponentially decaying, first-order equations. The 
Lyapunov analysis proves that the observer, given the above assumptions, is exponentially stable. A 
closed-loop analysis of the observer, coupled with a controller, is not presented. Nonlinear observers 
for gyro bias estimation are presented by Boskovic, et ail. in Refs. 12 and 13. In Ref. 12, the 
bias is assumed to be constant, which differs from the exponentially decaying model of Ref. 11. 
However, the bias is assumed to lie in a small, bounded set. Second order terms are neglected in 
the observer development and in the Lyapunov proof of stability. The observer is coupled with a 
controller, designed to drive the spacecraft rates to zero, and the spacecraft body coordinates to 
the inertial coordinates. With the second order terms neglected, the closed loop system is stable 
for the single scenario presented. In Ref. 13, the gyro bias observer is designed for use in attitude 
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tracking. Here the bias observer is driven by a computed attitude error, as in Refs. 9, 10, and 
11. However, the attitude error is computed as a vector difference, rather than a rotational error, 
without consideration to the normality constraint of the attitude. An adaptive tracking controller is 
coupled to the observer. The convergence proof for this observer assumes that the vehicle attitude 
never passes through ±180 degrees, and the stability of the coupled observer/controller/spacecraffc 
dynamics is not formally established. 

As the above discussion indicates, combined observer-controller designs for the attitude control 
of rigid flight vehicles are a subject of active research. 11-13 Successful design of such architectures is 
complicated by the fact that there is, in general, no separation principle for nonlinear systems. In 
contrast to linear systems, ‘certainty equivalence’ substitution of the states from an exponentially 
converging observer into a nominally stabilizing, state feedback control law does not necessarily 
guarantee stable closed-loop operation for the coupled systems. 14,15 In this work, one version of 
this problem is considered, in particular, the task of forcing the attitude of a rigid vehicle to asymp- 
totically track a (time- varying) reference attitude using feedback from rate sensors with persistent 
nonzero errors. 

The next section introduces the terminology used throughout the document, as well as an 
overview of a nonlinear attitude control law. Next, the development of nonlinear observers for the 
case of constant gyro bias, constant scale factor error, and constant alignment error are presented. 
Each observer is combined with the nonlinear control scheme for attitude control of a spacecraft. 
Simulation results are presented for each of the observers and for each of the closed loop systems. 
The paper concludes with a summary and discussion of future work. 


TERMINOLOGY 


The attitude of a spacecraft can be represented by a quaternion, consisting of a rotation angle 
and unit rotation vector e, known as the Euler axis, and a rotation <t> about this axis so that 16 



esin(|) 

cos(f) 



( 1 ) 


where q is the quaternion, partitioned into a vector part, e, and a scalar part, 77 . Typically, in 
spacecraft attitude applications, the quaternion represents the rotation from an inertial coordinate 
system to the spacecraft body coordinate system. Note that ||q|| = 1 by definition. The rotation 
matrix for a specific attitude can be computed from the quaternion components as 16 


R(q) = (tj 2 - e T e)I + 2ee T - 2r}S{e) 


( 2 ) 


where I is a 3x3 identity matrix and S{e) 
operation. 

S{e) = 


is a matrix representation of the vector cross product 
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The rotation matrix is orthogonal, R T R = I. Note also that R(q)£ = £. 

The relative orientation between two coordinate frames is computed as 17 
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( 3 ) 


Where q defines the rotation from the frame defined by <72 to the frame defined by q\. Note that 
||e|| = 0, fj — ±1 indicates that the frame 2 is aligned with frame 1. 


2 


( 4 ) 


The kinematic equation for the quaternion is given as 


= [•(!)] = ^ ( 9 ( *M f) 

where u>(t) is the spacecraft angular velocity in body coordinates and 


Q(g(t) = 


■r?(f)I + 5( e (f)) ' _ 

r Qi (</(*)) i 

-e(t) 

T -e(*) T J 


( 5 ) 


where, by inspection, Qi{q{t)) = The angular velocity, w(f), is typically measured 

by a gyro, which can be corrupted from various sources, such as errors in bias, misalignment, and 
scale factor, and noise. The measured angular velocity can be written as 1 


Ug(t) = rR T (q g )u(t) + b g (t) + v U g{t) (6) 

where u> g (t) is the angular velocity in the gyro coordinate frame, T is a diagonal matrix of scale 
factors, or more traditionally, a matrix containing scale factor errors (i.e. the main diagonal contains 
components 1 -f 7t, where ji is the scale factor error for gyro i). This work considers only the case of 
three, orthogonal gyros. Therefore, R(q g ) is an orthogonal gyro alignment matrix, a transformation 
from a gyro coordinate frame to the spacecraft body frame (note that for a non-orthogonal gyro 
triad, this matrix cannot be represented with a quaternion). The (possibly time varying) gyro bias 
is given by 6 5 (£), in the gyro coordinate frame, and finally, i/ Wff (£) is a zero mean noise vector, also 
in the gyro coordinate frame. 

Solving (6) for w(t), 

«(i) = C(Wg(t) - bg(t) - U ug {t)) (7) 

where C = (V R(q g ) T )~ l = R[q g )T~ l for three orthogonal gyros. Rewriting (7) as 

w(t) = Cu g (t) - b(t) - i/(t) (8) 

where b(t) = Cu) g (t) is the effective gyro bias in the spacecraft body frame, and, similarly, i/(t) is 
the effective noise in the spacecraft body frame. If T, q g , and 6(t) are known, an unbiased estimate 
of u;(t) is 

u>(t) = Cu g (t) - b(t) 

This paper considers the case where T, q g > and b(t) are unknown and of arbitrary size. 

In this work, the gyro alignment and scale factors are assumed to be constant. In other words, 


q g (t) = 0 (9) 

7 i(t) = 0 (10) 

The bias is assumed to be constant. 

b(t) = 0 (11) 

The effects of uniformly bounded noise on the bias and angular velocity are considered in Ref. 20. 

If 6(f), q g (t ), and f/(£) are estimates of the unknown bias, alignment quaternion, and inverted 
scale factor matrix, respectively, an estimate of the angular velocity is given as 


u>(t) = R(q g (t))Ti(t)u} g (t) - b{t) 


( 12 ) 


For the case of bias error only (assuming the alignment and scale factor matrices are known), (12) 
becomes 


u(t) = R{q g )T 1 uf g {t) - b(t) 


(13) 
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The equation is rewritten accordingly for a pure alignment estimate (with known scale factor and 
zero bias), as 

u(t) = R(q g (t))r~ l u g (t) (14) 

where R(q g (t)) represents the rotation from gyro coordinates to an estimated body frame. Finally, 
for an estimate of the inverted scale factor matrix (12) (with a known alignment and zero bias) 
becomes 

w(t) = R{q g )t i(t)u> g (t) (15) 

or similarly for any other combination of terms. 

The error terms for each of the calibration parameters are defined as 

b(t) = 6 -* b(t) (16) 

Qg{t) = q g ® 9sW _1 (17) 

7/(t) = 7/-7/W (18) 

where 7 j(t) is a scale factor error vector defined as the difference between the inverted true scale 
factors and the estimates. This work examines each error source separately. 


Nonlinear Control Algorithm 


The attitude dynamics for a rigid spacecraft are given as 

Hu{t) - 5(fTw(t))w(t) = u(t) 


(19) 


H is a constant, symmetric inertia matrix and u(t) is the applied external torque, for example, from 
attached rocket thrusters. The goal of the control law is to force the actual, measured attitude q(t) 
to asymptotically track a (generally) time-varying desired attitude qd(t) and angular velocity u; d (t), 
related for consistency by (4) as 

Qd(t) = ■ \Q(q d (t))u> d (t) 


( 20 ) 


It is assumed that u>d(t) is bounded and differentiable with u>d(t) also bounded. 
The commanded attitude tracking error is computed with (3) as 


Sc(0 

Vc(t) 


= q(t)®q d 1 (t) 


Qc{t) = 

Correspondingly, the rate tracking error is 

Wc(t) = w(t) - R(q c {t))u d (t) 

With these definitions, the tracking error obeys the kinematic differential equation 17 


( 21 ) 


( 22 ) 


he (t) = -Q(q c (t))u c (t) 


(23) 


A nonlinear tracking control strategy proposed by Egeland and Godhavn in Ref. 19 utilizes the 
control law 

u{t) = - K D s(t ) + Ha r (t) - S(Hu{t))u T (t) (24) 

K D is any symmetric, positive definite matrix and s(t ) is an error defined as 

s(t) = w c (t)t + A e c (f) = u(t ) - Lj r (t) (25) 
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where A is any positive constant. The reference angular velocity a ; r (£) is computed as 

u> r (t) = R(q c (t))u> d (t) - A e c (t) (26) 

and 

a r (t) = Wr(t) = fl(g c (t))u>d(t) - S(w c (t))fl(g c (t))w ci (t) - XQi{q c (t))u c (t)t (27) 

Asymptotically perfect tracking, i.e. e c (t) — ► 0, u> c (t) — ► 0, is obtained with the above control 
scheme, given noise free measurements of the states w(i) and q(t). In this work we investigate the 
application of this control algorithm, given the uncertainties in the angular velocity as quantified 
above. 


NONLINEAR OBSERVERS 


Following the observer proposed in Ref. 11, a state observer for the attitude in the case of either 
gyro bias or scale factor error is proposed as 

k(t) = ^Q(4(t))R(q 0 (t)) T [u(t) + ki 0 (t)sign(fj 0 (t))] (28) 

where cl>(t) is given in (13) for the case of gyro bias and in (15) for the case of scale factor error. 

The proposed observers for the gyro bias and scale factor errors are 
Gyro bias: 

b = — ^E 0 (t)sign(T/ 0 (t)) (29) 

Scale factor: 

4/<W = ^Ugi(t)£oi(t)sign(fjo(t)) (30) 


In the case of alignment error, the proposed attitude observer contains an additional term. The 
attitude and alignment observers are given as 

q(t) = + k{t)i 0 (t)sign(rj 0 (t)) + ki (t)sign(e 0 (f))sign(r) 0 (i))] (31) 

k 9 (t) = \Q(q g (m(q 9 (t)) T [(i - R(q o mR(.q 9 (t))u g (t)} (32) 

where u>(t) is as given in (14). The scalar gains k > 0, k(t) > 0, and &i(£) > 0 are defined below. 

For the gyro bias observer, the alignment and scale factor are assumed to be known. The same is 
true for the scale factor and alignment observers (the other components are assumed to be known). 

Essentially, q(t) is a prediction of the attitude at time t, propagated with the kinematic equation 
using the measured angular velocity and the current estimate of the error source, either gyro bias, 
scale factor, or alignment estimate. The attitude error is the relative orientation between the pre- 
dicted attitude provided by (28) or (31) and the true attitude provided by the measured attitude, 
q(t). The attitude error is computed using (3) as 


9o(*) = 




(33) 


In (28) and (31) the term R(q 0 (t)) T transforms the angular velocity terms from the body frame to 
the observer frame. 
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In the scale factor observer (30), i 0 i(t) are the three elements of i Q (t ). The estimated scale factor 
components, 7/t(t) with i — x,y,z, axe estimates of the inverse of the true scale factor components. 
Only scale factor estimates corresponding to non-zero u> gi (t) are included in (30). The components 
7 n(t) form the main diagonal of the matrix f/(t) in (15). Note that the estimated scale factors, 
7/i(t), are never inverted in the observer (or in the controller to follow), so dividing by zero is not a 
possibility. 

In the alignment observer (32), the quaternion, q g (t), is the estimated gyro alignment quaternion, 
transforming from gyro coordinates to an estimated body frame. The alignment error is given in 
(17). The term R(q g (t)) T transforms the angular velocity term from the gyro frame to an estimated 
body frame. 


In the case of pure bias error, the kinematic equation for q Q (t) is given as 


*>(*) = 2 


Qi(Qo(t)) 

-i 0 (tr 


(~b(t) - ki 0 (t)sign(fj 0 (t)) 


where b(t) obeys the differential equation 


1. 


&(*) = -e 0 (t)sign(7j o (t)) 


(34) 


(35) 


Note that the equilibrium states for (34) and (35) are 

[ q 0 {t) T b(t) T ] = [000 ±1 000 ] 

Ref- 20 proves that for any measured angular velocity, u* y (£) } the equilibrium states of the system 
(34) and (35) are exponentially stable. In particular, b(t) — ► b exponentially fast from any initial 
conditions q(to) and b(to). Additionally, Ref. 20 considers the effect of bounded noise on both the 
bias and angular velocity. Again, the observers are found to be exponentially stable to within a ball 
determined by the standard deviations of the noise terms. 


For pure scale factor errors, the derivatives of the attitude error, q Q (t ), and the scale factor error 
components are 



Q -i% ( r ] - ke 0 (t)sigB(um 


(36) 


= ~^gi{t)£oi(t)siga(fj 0 (t)) • (37) 

where again, i = x,y,z. T~ x is a diagonal matrix, containing the inverse of each of the true 
scale factors, defined as 7 /*, on the main diagonal. The scale factor errors are defined as 77 , (t) = 
in ~ 7 /i(f), with f /(t) given as 


f/W = 


7 ix(t) 
0 
0 


0 

0 


0 

0 


7 iz(t) 


The difference in angular velocity terms in (36) is then 

r_ 1 w 9 (t) - f/(i)w 9 (i) = f/(t)w 9 (f) = Qg(t)j/(t) 

where is a diagonal matrix with the components of u> g (t) on the matin diagonal and 7 /(t) is a 
vector containing the components 7 n{t). (36) can then be rewritten as 


Ut) = 2 


Qi(Qo{t)) 

-e 0 (t) T 


(fi g (t) 7 /(t) - ki 0 (t)sign(fj 0 (t)) 


(38) 
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Note that the equilibrium states for (37) and (38) are 

[ q 0 (t) T 7 i{t) T ] = [ooo±iooo] 

In the case of alignment error, the kinematic equation for the attitude error quaternion is 
Qo(t) ] W<7 9 )w g (t) - R(q g (t))w g (t) - k(t)i 0 (t)siga(fj 0 (t)) 

- Mt)sign(e 0 (t))sign(^ 0 (t))) (39) 

Since the true alignment is constant, the angular velocity associated with the kinematic equation for 
the true alignment quaternion is zero. The kinematic equation for the alignment error quaternion 
is therefore 

«.(*) = \ [ Q 4% ( fr } - I)R(q g (t))uM (40) 

Since R(q g ) = R(q g (t))R(q g (t)), where R(q g (t)) represents the rotation from the estimated body 
frame to the actual body frame, (39) becomes 

ho{t) =| [ [( R(Qg(t)) - I)R(.Qg(t))vg(t) ~ k(t)e 0 (t)sign(fj 0 (t)) 

— fci(t)sign(e 0 (<))sign( 7 o(f))] (41) 

Note that the equilibrium state for each of the error quaternions, q Q (t) in (41) and q g (t) in (40), is 
the identity quaternion, [0 0 0 ±1]. 


Stability of Scale Factor Observer 

The proof follows that of the gyro bias observer. 20 Chose a Lyapunov function as 

vm if - (fV , 1 / (*7o(0 - l) 2 + e 0 (t) T i 0 (t) V o(t) > 0 

Fo(t) 2 + 2 [ m) + 1)’ + «.(*)*■«.(*) m < o (42) 

V Q (t) is continuous. Noting that i 0 (t) T i 0 (t) + rj 0 (t)fj 0 (t) = 0, as with the gyro bias analysis, the 
derivative of V Q (t) (including the left and right derivatives of fj 0 (t) = 0) yields, for all t > t 0 


Vo(t) = 

This establishes that e 0 (£), fj 0 (t), and yn(t) 1 are globally, uniformly bounded. V Q (t) is a continuous, 
twice differentiable function with V a (t) bounded, given that u ) g (t) is bounded. Barbalat’s lemma 15 
then shows that ||e 0 (t)|| “ » ► 0 as t — > oo. 

If <*> g (t) is bounded, all the signals in (37) and (38) are bounded. The system is, as in the gyro 
bias case, analyzed as a linear time varying system, x(t) = A(t)x(t). 14 If all the components of 
c J g (t) are nonzero, A(t) is given as 


A(t \ _ [ -|sign(^ 0 (i))Qi(g 0 (t)) lQi(q 0 (t))n g (t) 


L o J 

If any of the components of c o g {t) are zero, the system is reduced in dimension according to the 
non-zero components of w ff (t). 

The development proceeds like that for the gyro bias in Ref. 20, under the assumption that 
u > g {t) is at least bounded. The equilibrium point x(t) = 0 of the equivalent system is exponentially 
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stable if the pair (A(t),C) is uniformly completely observable (UCO). Rewriting V 0 (t) as V 0 (t) = 
-x(t) T C T Cx(t) < 0, C is defined as C — J I 0 j- Equivalently to the gyro bias observer, the 
UCO property is examined with output feedback, resulting in a persistency of excitation condition. 
If the following is true for any bounded u> g (t ), for any z in R 3 



n g { T ) 2 }z > o 


(43) 


the system is UCO, and both £ 0 (t) and 7/(t) converge to zero exponentially fast. In other words, 
each component of must be nonzero for some nontrivial interval over any interval of length 
T 2 . (43) establishes the persistency of excitation (PE) condition for the scale factor observer. 


Stability of Alignment Observer 
Chose a Lyapunov function as 

y ,,X _1 \ - l) 2 + i 0 (t) T i 0 (t) fjo(t ) > 0 

2|W«) + l) J +Mr£.W Vo(t) < 0 

, 1 f (% («) - l) 2 + e a (t) T e 9 (t) V a (t) > 0 

2 \(V 9 (t) + l) 2 + £g(t) T ig(t) Tjg{t ) < 0 


(44) 


After considerable manipulation, with the choices k(t) = 4||u^(t)||H-fc' and ki(t) = fi||^ 3 (0lt + ^i> 
with any k f > 0 and k[ > 0, the derivative of V 0 (t) can be written as 


V 0 (t) < -fc'!|eo(t)|| 2 - feil|e 0 (t)|| < -k'\\i„m 2 


(45) 


If u> g (t) is bounded, V Q (t) is a continuous, twice differentiable function. Barbalat’s lemma then 
shows that ||£ 0 (t)|| — ► 0 as £ — ► oo. 15 


The system given by (40) and (41) is stable. If u? 5 (f) is bounded, all the signals are bounded. 
As with the gyro bias observer analysis, the system is cast as a linear time-varying system x(£) = 
A(t)x(t) where 14 

' £o{t) 


x(t) = 


,(t) J 


In this case, developing A(t) 
A(t) is written as 


is more involved. Again, after considerable manipulation, the matrix 


A(t) = 


An(t) 

Milt) 


Ai 2 {t) 

0 


where 

^n(f) = + klE 1 

A 12 (t) - - Oi(qoW)PW ff WKW)^(t) r 

- ft(«(i)K(t))I - t %(t)S(R(q g (t))u g m 

^2i(t) = - Qi(^(t))[(/e(^(t))^p(t))^(t)^ 

- (io(trR(q g (t))u; g m - Ut)S(R(q g (t))u> g m 

where E is a diagonal matrix with the inverse of the absolute values of the components of e Q (t) on 
the main diagonal, |e(t)*|*’ 1 * Again, as with the gyro bias and scale factor observers, the equilibrium 
point x(t) — 0 of this equivalent system is exponentially stable if the pair (A(t),C) is uniformly 
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completely observable(UCO). Rewriting V Q (t) as V 0 (t) < -x(t) T C T Cx(t) < 0, the matrix is C 
is defined as C = [\/A/ 0]. Examining the UCO properties, under output feedback, results in a 
persistency of excitation condition. Omitting the derivation details, if the following is true for a 
bounded u> s (t), for any z in R 3 


/>t+T a 

[ J -R(9sM) T ((w(t) t «(t))I - u(T)w{T) T )R(q g (T))d,T]z > 0 


(46) 


the system is UCO. In order to estimate the alignment errors, the angular velocity must change 
directions. Over any interval of length the angular velocity must not remain in a plane. If (46) 
is satisfied, the system is UCO, and the errors converge to zero exponentially fast. (46) establishes 
the persistency of excitation condition for the alignment observer. 


CLOSED LOOP STABILITY 


The nonlinear tracking control strategy proposed in Ref. 19 and summarized above cannot be 
implemented because exact measurements of the angular velocity u>(t) are not available. Instead, a 
certainty equivalence approach is proposed using estimates u?(t) generated by the observer equations, 
resulting in 

u(t) = —K D s(t) + Ha r (t) - S(HQ(t))uj r (t) (47) 

where s(t) = 6j(t) - cj r (t), & c (t) = w(t) - R(q c (t))wd(t ), and 

a r (t) = R(q c (t))vd{t) ~ S{u> c (t))R(q c {t))v d {t) - AQi(q c (f))u> c (t) 

Substitution of (47) into (19), the attitude dynamics, results in the following closed loop equation 20 

Hs(t) - S(Hw{t))s(t) + K D s(t) = A(q c (t), w d (t))s{t) (48) 

where A(q c (t),u d (t)) = -S(u> r (t))H - If5(i2(g c (t))a; d (t)) + A(q c (t)^ d (t)) is 

a bounded matrix over any solution of the coupled dynamics (28) or (31), (29) or (30) or (32), (19), 
and (47). 

In the case of gyro bias, the error term s(t) is written as 

s(t) = u>(t) — (1 >(t) = ~b(t) 

The closed loop dynamics are then written as 

Hs(t) - S(Hu>{t))s(t) 4- K D s(t) = —A(q c (t), u> d (t))b(t) (49) 

The control law (47) results in global stability and asymptotically perfect tracking, ||e c (£)|| — * 
0, ||u> c (£)|| — 1 ► 0. The proof is given in detail in Ref. 20. 


Closed Loop Stability with Constant Scale Factor Error 

Given the Lyapunov function V c (t) = s(t) T i/s(t), the derivative of V c (t), using (48), is 

V c (t) = -s(t) T K D s(t) + s(t) T A(q c (t), u d (t))(s(t) - s{t)) (50) 

Rewriting the error term 

s(t) - s(t) = u (t) - u(t) = r _ 1 w 9 (t) - f/(*)w 9 (t) 

= r~ 1 u> 9 (t)-f/(t)w 9 (t) 

= f l(t)U t (t) (51) 
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Since 


u g (t) = Tw(t) = r(a(i) + u> r (t)) 


(52) 


equation 51 is rewritten as 


s(t) - £(£) = f /(t)r(s(t) + o; r (£)) (53) 

The convergence of s(t) to zero depends on the exponential convergence of the scale factor errors, 
which in turn depends on the angular velocity cj p (£) generated by the applied control. The derivative 
of V c (t) can be written, after some manipulation, as 

v c (t) < -(^ - Cll7llll7/(t)ll)l|s(t)l| 2 + (54) 

where k D is the smallest eigenvalue of K D , 

C = sup sup || A(<j c (£), u? d (£))|| < oo 

t>to He (t) 11=1 

and ov,max is the upper bound of ||u? r (t)|| = ||il(g c (£))u? ti (£)-Ae c (£)|| < ||a; < i(£)||+A, since ||e c (*)|| < 1 
and ||R(g c (£))|| = 1. If k D is sufficiently large, the closed loop system is uniformly, ultimately 
bounded. If the angular velocity, w p (£), in addition to being bounded (which ensures that the 
observer error terms are at least bounded), satisfies (43), the system is UCO and the scale factor 
errors converge to zero exponentially fast. In this case Theorem B.8 of Ref. 15 applies. V c (t) 
converges to zero exponentially fast, which means s(t) converges to zero exponentially fast, regardless 
of the choice of k&- With the convergence of s(t) — ► 0, the proof of convergence of the actual attitude 
and rate errors follows exactly as in the gyro bias analysis of Ref. 20. The end result of which is 
Iim t _Mx>||S c (£)j| — 0 and lnn t _* cx> ||u; c (£)]j == 0. 


Closed Loop Stability with Constant Alignment Error 

Again, using the Lyapunov function V c (t) — ~s(t) T Hs(t ), the derivative of V c (t) is 

V c (t) = -s{t) T K D s(t) + s(t) T A(q c (t), u> d (t))s(t) (55) 

The error term s(t) is rewritten as 

s(t) - s(t) = io(t) - u>(t) = u>{t) - R(q g (t))u> g (t) = (I- R(q g (t)) T )u(t) 

Substituting v(t) = s(£) + u; r (£) from equation 25, s(£) is 

s(t) = (I - R(q g (t)) T )u(t) = (I- R(q g (t)) T )(s(t) + u> r (t)) (56) 

The convergence of s(t) to zero depends on the exponential convergence of the alignment errors, 
which in turn depends on the angular velocity u>(t) generated by the applied control. The derivative 
of V c (t) can be written, again, after some manipulation, as 

Vc(t) < -(y -2CI|e- 9 (*)ll)l|s(t)|| 2 + ^jf^\\i 9 (t)\\ 2 (57) 

where k D , C, and oj r ,max are defined above. Again, if k D is sufficiently large, the closed loop system is 
uniformly, ultimately bounded. If the angular velocity, u>(£), in addition to being bounded, satisfies 
(46), the system is UCO and the alignment errors, e p (£), converge to zero exponentially fast. As in 
the case of scale factor error, Theorem B.8 of Ref. 15 applies. V c (t) converges to zero exponentially 
fast, which means s(t) converges to zero exponentially fast, regardless of the choice of k^- With 
the convergence of s(t) — » 0, the proof of convergence of the actual attitude and rate errors follows 
exactly as in the gyro bias analysis of Ref. 20. The end result of which is limt_ >00 ||e: c (£)|| = 0 and 
lim t _ 00 ||a? c (£)|| — 0. 
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OBSERVER SIMULATION RESULTS 


The observers are tested with a Matlab simulation. Table 1 lists the initial conditions for each 
observer, as well as the true states. The initial attitude quaternion and initial estimated attitude 
quaternion are the same for each observer test. 


Observer State 

Value 

True State 

Value 

q(to) 

[0,1,0, or 

q{t 0) 

[0,0,1, or 

Ht 0) 

[0,0,0] r £f 

b(t) 

[2.9, -2.9, 1.9] T £? 

7 (t) 

[1,1,1] 

7 

[3, -5, 4] 

4g(t) 

[0,0, 0,1] 

9s 

[0,0, 1,0] 


T^ble 1 Observer Simulation Initial Conditions 


First, results from the gyro bias observer are presented. The scale factors and alignment are 
known (and, without loss of generality, are each set to identity). The gain is chosen as k = 1. The 
angular velocity is a >(t) = [—5.7, 11.4, —22.9] deg/sec. Figure 1 shows ||6(t)|| converges to zero 
exponentially fast. 



Figure 1 Observer Gyro Bias Error 

Next, results from the scale factor observer are presented. Here the gyro bias is zero, and the 
alignment matrix is the identity matrix. In the first case, the angular velocity is the same as in 
the gyro bias observer tests with u>(t) T = [—5.7,11.4,-22.9] deg/sec. Figure 2(a) shows that the 
scale factor errors, 7 j — 7 /(£), converge to zero. (Note that the inverse of the scale factor errors are 
plotted. Only the inverse of the estimate is used in the observer.) 

In the second case, the x and y angular velocity components are as in the first case, but the 
z component is zero, u(t) = [—5.7,11.4,0] deg/sec. Recall that the PE condition requires that all 
components of cj(t) be nonzero for UCO. Figure 2(b) shows that the scale factor errors for the x 
and y axes converge to zero, but the scale factor error for the z axis remains constant. 

In the next case, the angular velocity components decrease exponentially <v(t) — [—5.7, 11.4, — 22.9]e“* 
deg/sec. This angular velocity does not meet the persistency of excitation condition of (43). Figure 
2(c) shows that the scale factor errors do not converge to zero, but rather to constants. 
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In the last case, angular velocity components switch between zero and w g (t) = [-5.7, 11.4, —22.9] 
deg/sec. A simple time interval is set up as 


v (t) — f I” 5 ’ 7 ’ “22.9] deg/sec t € [n, n + l/(n 4- 1)] 

9 | [0,0,0] deg/sec t € [n + l/(n + l),n -f 1] 


where 


t n = n, n = 1,2, . . . 200 


This case also does not meet the UCO requirement of (43), since the angular velocity components 
are zero for progressively longer intervals. Figure 2(d) shows that the scale factor errors do not 
converge to zero, but rather are converging to constants. 




(a) Constant Angular Velocity (b) Zero Z Angular Velocity 



(c) Exponential Angular Velocity (d) Non-Constant Angular Velocity 


Figure 2 Scale Factor Observer Inverse Scale Factor Errors 


Finally, results from the alignment observer are presented. The gyro bias is zero, and the scale 
factor matrix is the identity matrix. In the first case, the angular velocity is constant, with u>(t) T — 
[0.1, 0.1, 0.1] deg/sec. The gains are chosen as k f = 1, k[ — 0.001. Figure 3(a) shows that the 
alignment errors converge to a constant, since a constant angular velocity does not meet the PE 
condition required by (46). 

Next, the angular velocity is time varying. The angular velocity is 
u )(t) T = [cosu> m £,smc<; m t, cos 2a; m t]deg/sec 

where o; m = 2 rad/sec. The gains are chosen as k' = 0.001 and k[ = 0.1. It can be shown that 
this angular velocity does meet the persistency of excitation condition of (46) for alignment errors. 
Figure 3(b) shows that alignment errors converge to zero. 
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Figure 3 Alignment Observer Alignment Error 


Observer State 

Value 

True State 

Value 

q(t 0) 

[0,0,0, if 

Q(t 0) 

[0,1,0, Of 

h(to) 

M.Ofif* 

6(f) 

[2.9, —2.9, 1.9f 

7 w 

[1.1,1] 

7 

[3, -5, 4] 

Qg(t) 

[0,0,0, If 

<2d(to) 

[0,0, 0.3827, 0.9238f 
[0,0,0, If 


Table 2 Closed Loop Simulation Initial Conditions 


CLOSED LOOP SIMULATION RESULTS 


The combined observers and controllers axe also tested with a Matlab simulation. The inertia 
matrix is a diagonal matrix with principal moments of inertia chosen arbitrarily as [90, 100, 70] kg m 2 . 
The size of the principal moments of inertia is comparable to that of a small satellite. Table 2 lists 
the initial conditions for the observer and controller, as well as the true states. All the tests start 
with the same initial attitude quaternion, initial observer attitude quaternion, and initial desired 
attitude quaternion. 

The combined observer /controller is first tested with a gyro bias. The gains are chosen as k = 1, 
K D = fc D I, k D = 6, and A = 3. The desired trajectory is to track a 6.3 deg/sec rotation about 
the y-axis. The initial angular velocity is w(io) — [—5.7, 11.4, — 22.9] r deg/sec. Figure 4(a) shows 
that ||6(£)|| converges exponentially to zero. Figure 4(b) shows the tracking error, ||e c (t)||, converges 
asymptotically to zero. Figure 4(c) similarly shows that the rate tracking errors converge to zero. 
Without correcting for the bias, the tracking error has a steady state error of approximately 30 
degrees, as shown in Figure 4(d). 

Next, the coupled observer/controller is tested with a scale factor error. The gains are chosen 
as k = 1, K d — k D h (where 1 3 indicates a 3x3 identity matrix), k D = 20, and A — 0.1. Here the 
initial angular velocity is u>(0) r = [0,0,0], and the desired angular velocity is constant, u> d (t) T — 
[2.8, 2.8, 2.8] deg/sec. Figure 5(a) shows that the scale factor errors converge to zero. Figures 5(b) 
and 5(c) show that both the tracking attitude error and the tracking angular velocity error converge 
to zero. The controller is then run without correcting for the scale factor. Figure 5(d) shows the 
attitude tracking error, with the true scale factor reduced by a factor of 100 (the scale factor given 
in Table 2 produced tracking errors considerably larger). Without correcting for the scale factor, 
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Figure 4 Coupled Observer/Controller With Gyro Bias 


the tracking errors do not converge. 

Finally, the coupled observer/controller is tested with a constant alignment error. The gains are 
chosen as k* = 0.1, k[ ~ 0.1, K D — k D I 3 (where I 3 indicates a 3x3 identity matrix), k D — 20, and 
A = 3. The initial angular velocity is cj(0) t = [0,0,0]. The gyro coordinate frame is rotated by 
45 degrees from the body frame, about the z-axis. The desired angular velocity changes direction, 
similarly to that used above to test just the observer, u>d(t) T — 5.73[cosa> m t,sinci; m t,sin2ct; m t] 
deg/sec, with uj m — 1 deg/sec. Here, all the errors converge to zero. Figure 6(a) shows that the 
alignment errors converge to zero. Figures 6(b) and 6(c) show that that attitude and rate tracking 
errors converge to zero. Without correcting for the alignment, the attitude tracking error does not 
converge to zero, as shown in 6(d). 


CONCLUSIONS 


Three nonlinear observers for estimation of gyro bias, scale factor error, and alignment error 
are presented. All the observers are stable. The bias observer is exponentially stable. Both the 
scale factor and alignment observers are exponentially stable, but only under the condition that 
the angular velocity is bounded and meets a persistency of excitation condition. The persistency of 
excitation conditions are different for the scale factor observer and the alignment observer. For the 
scale factor observer, the angular velocity must be bounded and at least constant for regular time 
intervals. For the alignment observer, the angular velocity must be bounded, and must also change 
direction sufficiently in order to estimate the alignment. 

Each observer is also coupled with a nonlinear control algorithm for attitude control of a rigid 
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(b) Trar.king Attitude Error 



rect for Scale Factor 


Figure 5 Coupled Observer /Controller with Scale Fhctor Error 


spacecraft. The coupled observer/controller in the case of bias error is stable. The tracking attitude 
and rate errors converge asymptotically to zero, and the bias errors converge exponentially to zero. 
The coupled observer/controller in the case of scale factor errors is stable, and converges asymptoti- 
cally if the angular velocity is bounded and satisfies the pertinent persistency of excitation condition. 
The same is true for the coupled observer /controller in the case of an alignment error. The closed 
loop system is asymptotically stable if the angular velocity is bounded and meets the persistency of 
excitation condition for the alignment observer. 

In this work, the three gyro observers are developed and tested independently. Since they 
are stable (exponentially stable under certain conditions) when examined alone, the next step is 
to understand the stability of simultaneously estimating combinations of bias, scale factor error 
and alignment error using the observers presented here. Future work will examine the stability of 
combining the observers, as a potential nonlinear gyro calibration utility. Additionally, the stability 
of combinations of the observers, coupled with a control algorithm, will be assessed. Uniformly 
bounded noise will also be considered in the analysis of the combined observers. 
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